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@ Mit der Erfindung wird eine autonome mobile Einheit 
vorgestellt, die einen zusammenfaltbaren Manipulatorarm 
besitzt, dessen Ende als Effektor, beispielsweise eine Saug- 
duse Oder ein Pinsel ausgebtldet ist. Der Arm ist dabei 
drehbar an der autonomen mobilen Einheit befestigt und 
kann eine Flache uberstreichen. Er besteht aus mehreren 
Segmenten, die an ihren Enden drehbar miteinander verbun- 
den sind. Die jeweiligen Drehwinkel konnen unabhangig 
voneinander eingestellt werden. So ist es moglich, eine hohe 
Flexibilitat bei der Bewegung des Armes zu erreichen. Das 
Steuerungsverfahren gibt einen vorteiihaften Algorithmus 
an, mit dem die Einheit und der Manipulatorarm gesteuert 
werden konnen. Es wird erne Hybridvariante favorisiert, bei 
der der Effektor mit einer Andruckkraft, die durch einen 
Kraftsensor gemessen wird, an eine Wand gedruckt wird 
und dabel die Einheit dem Effektor folgt. Einsatzbereiche 
sind beispielsweise Industriestaubsauger, autonome Robo- 
ter die Wande anstreichen sollen oder postaustragende 
Fahrzeuge. 
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Beschreibung 

Der Trend in der technischen Entwicklung geht dahin, regelmaBig wiederkehrende Tatigkeiten von Maschi- 
nen ausftihren zu lassea Es wird weiter versucht, auch T^tigkeiten die.eine gewisse MobilitSt erfordem von 

5 Maschinen verrichten zu lassen. Beispiele ftir solche TStigkeiten sind das Austragen von Post, Reinigungstdtig- 
keiten, oder das Fullen von Flachen mit Farbe. FOr diese Verrichtungen werden hSufig autonome mobile 
Einheiten eingesetzt Diese mtissen sich dabei in unstrukturierten mit Hindemissen versehenen Umgebungen 
bewegen. Dazu benotigen sic geeignete Orientieningsverfahren und Sensoren, mit denen sie in ihrer Umgebung 
in Wechselwirkungen treten k6nnen. Von W.D. Rencken wurde mit dem Artikel "Concurrent Localization and 

10 Mapbuiiding for mobile Robots using Ultrasonics-Sensors" zu. PROC 1993 lEEE/RSJ. Internationa! Conference 
on Intelligence Robots and Systems, Yokohama, Jap. 26.— 30. Juli 1993, Seite 2192 bis 2197 ein Verfahren 
vorgestellt, welches sich mit der Orientierung und Wegfindung in unbekannten Umgebungen befa&t und dafUr 
eine Losung aufzeigt. Ein weiteres Problem solcher autonomen mobilen Einheiten besteht darin, daB diese einen 
einfachen platzsparenden Manipulator besitzen mttssen um die entsprechenden Tatigkeiten verrichten zu k5n- 

15 nen. Hierzu ist keinerlei Stand der Technik bekannt. 

Die der Erfindung zugrundeliegende Aufgabe besteht deshalb darin, eine autonome mobile Einheit anzuge- 
ben, die einen Manipulator besitzt, der eine groOe Reichweite innerhalb der Fl^che besitzt, auf der sich die 
Einheit bewegt und der die Einheit nlcht bei ihrer Bewegung behindert Weiterhin soil fOr die Einheit und den 
Manipulator ein geeignetes Steuerungsverfahren angegeben werden. 

20 Fiir die Einheit und den Manipulator wird diese Aufgabe gemSD den Merkmalen des Patentanspruches 1 
geldst. FUr das Steuerungsverfahren wird die Aufgabe gem^B den Merkmalen des Patentanspruches 1 1 geldst 
Weiterbildungen der Erfindung ergeben sich aus den UnteransprUchen. 

Ein groBer Vorteil der erfindungsgemaQen Einheit besteht darin, daB sie durch einen Manipulatorarm nicht an 
der Bewegung in komplexen Umgebungen gehindert wird und dabei der Manipulator sehr kompakt ist im 
25 Vergleich zu seiner Reichweite. Vorteilhaft kommen dabei im eingezogenen Zustand die einzelnen Segmente 
des Manipulators ubereinander zu liegen und schlieBen mit der Kontur der autonomen mobilen Einheit ab, so 
daB deren Grundflache durch den Manipulator nur unwesentlich vergrdBert wird. 

Vorteilhaft lassen sich die einzelnen Segmente des Manipulators durch SeilzUge, welche Ober Umlenkrollen 
gefuhrt sind, betatigea Diese AusfQhrungsform kommt besonders einer Anwendung im Konsumentenbereich 
30 zugute, da sie technisch nicht sehr aufwendig und in der Praxis vielfaitig erprobt ist 

Vorteilhafterweise sind in den einzelnen Drehgelenken des Manipulatorarmes Stellmotoren vorgesehen, 
welche unabhangig voneinander das jeweilige Segment in eine von der Steuerung vorgegebene Drehlage 
bringen konnen, Durch eine gezielte und direkte Beeinflussung der einzelnen Manipulatorsegmente kann 
flexibel und schnell auf sich andernde Umgebungsbedingungen reagiert werden. 
35 Ein weiterer Vorteil der erfindungsgemSBen Einheit besteht darin, daB der Manipulatorarm innen hohl 
ausgebildet ist, und daB die einzelnen Segmente druckdicht miteinander abschlieBen. So kann beispielsweise 
Farbe aufgebracht werden oder es kann durch einen Unterdruck Schmutz von Flachen abgesaugt werden. 

Ein weiterer Vorteil wird bei der erfindungsgemaBen Einheit dadurch erzielt, daB das letzte Segment des 
Manipulatorarmes als Effektor ausgebildet ist So kann beispielsweise ein Pinsel oder eine Saugdlise direkt 
40 gesteuert werden und exakt nach Vorgabe der Steuerung in der Umgebung positioniert werden, um beispiels- 
weise einer Wand zu folgen, oder ein vordefiniertes Bewegungsmuster abzuarbeiten. 

Vorteilhaft ist ein solcher Effektor einer autonomen mobilen Einheit mit einem Sensor ausgestattet der auf 
Hindernisse reagiert So laBt sich auf einfache Weise der Effektor entlang einer Wand fiihren. Bildet man diesen 
Sensor vorteilhaft als KraftmeBfuhler aus, so kann zusatzlich ein entsprechendes Moment von der Steuerung 
45 vorgegeben werden mit dem eine AnpreBkraft des Effektors an beispielsweise eine Wand erzielt werden kann. 
Vorteilhaft ist dieser Kraftsensor als Rad ausgebildet das mit einer Achse auf dem Effektor befestigt ist wobei 
an der Achse DehnmeBstreifen angebracht sind, mit welchen der Kraftvektor bestimmt werden kana Durch das 
Rad wird zuverlassig vermieden, daS Reibungseinflilsse die SteuervorgSnge verfaischen k6nnen. 
Vorteilhaft wird die erfindungsgemaBe Einheit nach einem Steuerverfahren betrieben, welches die Bewegung 
50 der autonomen mobilen Einheit in der Umgebung und des Effektors, welcher an einem Geh^usepunkt an der 
Einheit angebracht ist berucksichtigt So kann vorteilhaft in jenen Teilen der Umgebung, die nicht mit Hinder- 
nissen verstellt sind, der Effektor an der Einheit angelegt werden und in anderen Teilen der Umgebung, die es 
erforderlich machen, der Effektor ausgefahren werden und unterhalb von Gegenstanden der Umgebung operie- 
ren. Weiterhin ist im erfindungsgemaBen Verfahren vorteilhaft vorgesehen, daB der Effektor nie in eine singulS- 
55 re Position gerSt von der aus er nicht mehr operieren kann. D. h. fiir den Fall, daB er zu nah an der Einheit anliegt, 
wird diese in ihrer Bewegung abgestoppt bzw. fUr den Fall, daB eine vollstandige Streckung des Manipulators 
droht wird die Einheit hinter dem Effektor hergefuhrt um den Manipulator wieder einzuknicken. Vorteilhaft ist 
es vorgesehen, den Effektor mit dem erfindungsgemaBen Verfahren hybrid zu steuern, d. h. in eine Koordinaten- 
richtung wird eine Kraft aufgebracht welche durch den KraftmeBftihier bestimmt wird und in die andere 
60 Richtung wird durch die Steuerung eine konstante Geschwindigkeit vorgegeben und eingehalten. 
Im folgenden wird die Erfindung anhand von Figuren weiter erlSutert 

Fig. 1 a und b zeigen ein globales bzw. ein lokales Koordinatensystem des Manipulators bzw. des Effektors. 

Fig. 2a und b zeigen Beispiele fur die Regelung des Effektors. einmal fOr den Fall das freie Fahrt stattfindet 
und zum anderen Mai fiir den Fall, das der Effektor einer Wand folgen soil. 
65 Fig. 3 zeigt ein AusfOhrungsbeispiel eines Effektors mit einem Kraftsensor. 

Fig. 4a und b zeigen eine erfindungsgemaBe autonome mobile Einheit einmal mit einem ausgefahrenen und 
das andere Mai mit einem eingefahrenen Manipulatorarm. 

Fig. la zeigt ein Koordinatensystem das sinnvollerweise fiir die Modellierung des Manipulatorarmes in der 
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Steuereinheit der mobilen Einheit verwendet wird Im Punkt A ist der Manipulator an der autonomen mobiien 
Einheit befestigt und drehbar gelagert Zur Vereinfachimg der Steuervorgange wird in diesera Punkt ein 
Geschwindigkeitsvektor o vorgegcben. Die Lage der einzelnen Segmente SGI bis SG3 laBt sich dann durch die 
einzelnen Winkei <D1, 02 und <D3. welche die jeweiligen Armsegraente raiteinander bilden, beschreiben. Das 
Segment SG3 kann beispielsweise auch als Effektor ausgefUhrt sein. Mit diesem Effektor kann die autonome 5 
mobile Einheit beispielsweise Post austragen. Wande bemalen. Staubsaugen, oder ahnliche Verrichtungen 
durchfuhren. Flir die Modeliierung des Manipulatorarms wird vorteilhafter Weise davon ausgegangen, da3 die 
Dynamik des Armes keine Auswirkungen auf die Dynamik der autonomen mobilen Einheit hat Diese Annahme 
wurde gemacht, da sie sonst ein System mit sechs AUgemeinen Variabeln ergeben wQrde, welches sechs 
Differentialgleichungen zweiter Ordnung zur Folge hatte. Ein solches Gleichungssystem ist schwierig lOsbar. Im 10 
Formelteil sind in Gleichung 9 die Allgemeinkoordinaten in Gleichung 10 die verallgeraeinerten Krafte und in 
Gleichung 11 die kinetischen Energien angegeben. Aus diesen Energien ergibt sich die Gesaratenergie des 
Systems zur Gleichung 12 und die potentielle Energie aus Gleichung 13. Zur weiteren Herleitung der Zusam- 
menhange warden die Gleichungen 12 und 13 in die Gleichung 8 eingefilgt, welche dann in Verbindung mit den 
Gleichungen 9 und 10 in die Gleichung 7 eingesetzt wird, um die Differentialgleichungen zweiter Ordnung zu 15 
erhalten. 

Experimentell wurde verifiziert, daB diese Differentialgleichungen zweiter Ordnung sehr schwer zu Idsen sind, 
da die Rechenkapazitat der heutigen Steuerungsrechner nicht ausreicht, um dies in einer akzeptablen Zeit zu 
bewerkstelligen. Ein MaB fOr diese Zeit ist beispielsweise die erforderliche Reaktionszeit der Einheit, oder die 
minimale Zykluszeit, mit der die Steuerung der Einheit arbeitet Aus diesen GrOnden wurde die oben gewahlte 20 
Einschrankung bezuglich der Dynamik gemacht 

Das in Fig. la dargestellte Modell des Manipulatorarmes laBt sich einfacher berechnea Die verallgemeinerten 
Koordinaten sind in Gleichung 14 und die verallgemeinerten Krafte in Gleichung 15 angegeben. Die kinetischen 
Energien ergeben sich aus Gleichung 16 und die kinetische Energie des Systems wird in Gleichung 17 dargestellt 
Die potentielle Energie des Systems wird mit Gleichung 18 beschrieben. Bei diesem Lfisungsansatz wurde die 25 
Annahme gemacht, daB der Punkt A in dem der Manipulatorarra befestigt ist. eine Position und eine Geschwin- 
digkeit und eine Beschleunigung aufweist Damit wird eine Bewegung bzw. eine Beschleunigung oder Verzoge- 
rung der mobilen Einheit an der der Arm befestigt ist, beschrieben. Zur L6sung der Diff erentialgleichung werden 
die Gleichungen 17 und 18 in die Gleichung 8 eingesetzt Zusammen mit den Gleichungen 14 und 15 werden sie 
dann in die Gleichung 7 eingesetzt, um die Differentialgleichungen zweiter Ordnungen zu erhalten. Aus dieser 30 
Vorgehens weise ergeben sich drei Differentialgleichungen zweiter Ordnung. Zur Bewegungssteuerung des 
Armes mussen diese drei Differentialgleichungen siraultan f(ir die zweiten Ableitungen der verallgemeinerten 
Koordinaten geldst werden. Die Lfisung dafiir wird mit Hilfe der linearen Algebra gefundea Gleichung 19 
reprasentiert dabei die Form der Gleichungen, welche man aus der Lagrange'schen Dynamik erhalt Zur LSsung 
dieser Gleichung muB die Matbc M und der Vektor N entwickelt werden. Die Variable P ist der Vektor der 35 
zweiten Ableitung der verallgemeinerten Variablen. Die allgemeine Form ist in Gleichung 20 und die speziellen 
Werte fur dieses System sind in Gleichung 21 angegeben. Die Matrbc M ist in Gleichung 22 und der Vektor N in 
Gleichung 23 dargestellt Aus der Ldsung der Gleichung 19 fur V. ergeben sich die Differentialgleichungen, die in 
den Formeln 25 bis 27 dargestellt sind. Jede Gleichung wird durch denselben Faktor D dividiert, welcher die 
Determinante der Matrix M darstellt und in Gleichung 24 angegeben ist Mil diesem speziellen Losungsbeispiel 40 
1st es moglich, die Bewegungen des Manipulators und des angebrachten Effektors mit akzeptablen Zeitverhalten 
zuberechnen. 

Fig. lb zeigt den Effektor EF, welcher an einem Segment des Manipulatorarmes SG eingebrachi ist FUr 
diesen Effektor wird vorzugsweise ein lokales Koordinatensystem Yf und Xf verwendet Dieses Koordinatensy- 
stem bildet mit den globalen Koordinaten den Winkei Of. Bei der Bewegungssteuerung des Effektors wird 45 
vorteilhafterweise der EinfluB des Fahrzeuges, dessen Wechselwirkung mit dem Arm und die Wechselwirkung 
des Effektors mit dem Arm berOcksichtigt Der Arm fungiert dabei als Bindeglied zwischen dem Fahrzeug und 
dem Effektor EF. Zur Manipulatorsteuerung kann beispielsweise die Position des Armes kontrolliert werden. 
Das bedeutet, daB mit dem Effektor des Armes eine bestimmte Zielposition angesteuert werden soil. Diese 
Position wird dabei in kartesischen Koordinaten als Winkei des Effektors mit dem globalen Koordinatensystem 50 
beschrieben, wobei daraus die einzelnen Winkei zwischen den unterschiedlichen Segmenten des Armes berech- 
net werden konnen. Die Zielposition wird dabei in kartesischen Koordinaten des Effektors EF angegeben. 
Daraus lassen sich die einzelnen Winkelpositionen der unterschiedlichen Segmente berechnea Aus denen 
wiederum lassen sich die einzelnen Drehmomente ableiten, welche fQr Antriebsmotoren gelten mttssen. die an 
den einzelnen Geienken zwischen den jeweiligen Segmenten des Manipulatorarmes angebracht sind. Kl und K2 55 
sind dabei Kontrollparameter; die resultierende Gleichung ist in Gleichung I des Forraelteiles angegeben. Dabei 
bedeutet der Index i die Nummer des Segmentes, wobei das Segment 1 direkt mit der autonomen mobilen 
Emheit verbunden ist und der hochste Wert, beispielsweise 3 den Effektor bedeutet Der Winkei 0 ist dabei in 
lokalen Koordinaten angegeben. Um ein geschmeidigeres Bewegungsverhalten des Manipulators zu erzielen, ist 
es jedoch vorteilhafter nicht die Position sondern die Geschwindigkeit des Effektors zu kontroilieren. eo 

Fig. 2a zeigt ein regelungstechnisches Blockschaltbild fiir die KontroIIe der Geschwindigkeit des am Manipu- 
lator angebrachten Effektors EF. Die KontroIIe der Geschwindigkeit anstatt der Position des Effektors kann 
verwendet werden, um eine geschmeidigere Bewegungstrajektorie des Effektors zu erhalten. Den Angaben in 
Fig. 2a liegt wiederum das Koordinatensystem aus Fig, lb zugrunde. Beispielsweise sind von einem Benutzer 
Oder von der Steuereinheit die Geschwindigkeiten Xf, Yf und <I)f vorgebbar. Aus diesen Geschwindigkeiten 65 
werden die Winkelgeschwindigkeiten der einzelnen Motoren, die an den Geienken der Segmente des Manipula- 
tors angebracht sind, berechnet Die dafiir gOltige Herleitung kann wiederum aus dem Formelteil entnommen 
werden. Am Effektor k6nnen drei unterschiedliche Geschwindigkeiten kontrolliert werdea Zum einen die 
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kartesischen Geschwindigkeiten x, und 6f und die Winkelgeschwindigkeit des Effektors Zur Steuerung der 
autonoraen mobilen Einheit sollten die Geschwindigkeiten die von der Stcuereinlieit oder vom Benuteer voree- 
geben warden, verwendet werden, um die einzelnen Winkelgesciiwindigkeiten der Gelenke zu bestimmen. Die 

iu ShZ^lllu„T^'w'^^•'^'''?^^^ G"«chungen 28 bis 36 angegebea S Qr 

1^ r geltenden Herlertungen sind in den Gleicliungen 37 und 38 und die resultierende Transfor- 

mation in Gleicliung 39 angegeben. Die einzelnen Motordrelimoraente wurden dabei so gesteuert, wie sie in der 
Gleicliung 2 angegeben sind. Dabei bedeuten die Konstanten Kl bis K3 die einzelnen Steuerpararnetcr 
ni?fn R/?;fi?'Pv' «8«'""««echnisclie Blocksclialtbild verdeutliciit die einzelnen ZusammenhSnge. 
SoS;h.if fn !;^i,yf p««=»'windigkeitsregelung kann verwendet werden. wenn sich die autonome 
mobile Einhei in einer Umgebung bewegt. die weitestgeiiend von Hindemissen frei ist FOr diesen Fall gilt. daB 
keine Wechselwirkungen wie Reitkrifte oder Impulse auf den Manipulator einwirken und so keine dadurcii 
hervorgeruf enen Schwingungen in der Steuerung des Armes auftreten kOnnea 

F.g. 2 zeigt em beispielhaftes Biockschaltbild fQr die Regelung des Manipulators, wenn auf diesen eine Kraft 
von auBen einwirkt Diese Kraft kami beispielsweise mit einem KraftmeBfOhle;. welcher an dem EffSr 
angebracht ist; gemessen werden. Der Kraftwert wird beispielsweise an die Steuereinheit weitergeleitet und 
diese steuert die Motormomente dahingehend. daB diese Kraft bezUgUch einer Umrandung beispielfweise einer 

£!.rnf„lT.""f -'II''""^ '^"Tn "^""^ "^o""""* g^halten wird. Bd dieser vorteilhaf?en 

Steuerung der erfindungsgemiBen autonomen mobilen Einiieit wird das Hybridprinzip verwendet Dabei wird 
versucht m eine Richtung des lokalen Achsenkreuzes des Effektors beispielsweise der Y-Riclitung den Effektor 
ZZr, A I''' A P?fV««8en eine Wand des Raumes. in welchem sich die Einheit bewegt. zu p esseru 
Parallel zu der Wand, beispielsweise m X-Richtung wird eine bestimmte Geschwindigkeit der Einheit bzw. des 
Effektors emgehalten. Vorte.lhaft kann bei der erfindungsgemaBen AusfUhrungsform fuf eine Entkoppiu J m" 
tnx verzichtet werden. Die anzuwendende Kraft kann dabei beispielsweise von einem Benutzer in AbSkek 
der vorliegenden Anwendung vorgegeben werden. Die Drehmomente zur Erzeugung der korrekten Winkelee- 
" uSfT" t'u G-^'enken werden dabei berechnet. wie dies bei der Methode der GeschSg- 

,HHi!.rM,nH ■ ^"^"i^heBend werden die jeweiligen Momente fOr die Geschwindigkeiten und die Kraffe 

addiert und gememsam damit die einzelnen Motoren angesteuert <= isjdi ic 

*?'"^u'^' '"^''*?°"'^"* ^" beachten. daB sowohl die Einheit als auch der Effektor unterschiedliche 
m« «n Slr'^!" ^'''^Z" unterschiedlichen Bewegungen werden dabei Terlagert Sd 

Tre l£lfrls?in I'"".^ berlicksichtigt werden Das erfindungsgemSBe Verfahren vermeidet dabei insbeson- 
dere Smgularitaten des Systems. Das Steuerverfahren beruht dabei prinzlpiell darauf. daB wenn der Arm einen 
St?tSzt*SS'ih J'"?'"! ^™ ^"v f^'g^'- ««besondere kann dabdeine siihTrh its- 

w^rHinTn fific A A ' TJ"'^''' Reichweite des Arms begrenzt wird. Beispielsweise kann sie so gewahit 
A m loool ' 1^^° i?" M-^"^' ^"'^l!' ^'•'^""8 dem Arm folgt und somit verhindert. daB der 
ilTrS^A A ""^e 'Chen Strecklange erreicht Dasselbe kann beispielsweise fQr das innere Ende der 
Rewhweite des Arms gelten. Beispielsweise kann falls der Arm 15o/o seiner totalen Streckl§nge erreicht hat das 

^rH^'Z^-^ ^'w ^"^S"- ''"^ " '''^ wegbewegt Mit dem erfindungsSf STverfahren 

wird auf diese Weise ein reflexartiges Verhalten der autonomen mobilen Einheit erreifhf. Der Vorgang des 
Anpressens des Ef ektors an eine Wand und der Vorfahrtsfahrt der Einheit ISBt sich analog m Sem E^chen 

/e^;?!"^"- "T^- tf ^""^^^^^ ^""hrung. der Wan'd mi t de Sand fSgt 

Fig 3 zeigt ein Beispie eines Effektors der einen KraftmeBfOhler besitzt Die Fig. 3a ist eine Draufsicht und in 

S^r AcWArH'^HK ''^ ^""h!°r^ g^-^'e'- Der KraftmeBfOhler besteht dabei aus einem Radt das a" 
K?aftve2or der H ' 'f " ^''l^' ' "'^ DehnmeBstreifen angebracht. mit denen ein 
SurnhPrl^rhP^ , •5'"' ^-T'^^' ^"^en kann. Um ein Verkanten des Effektors in engen 

S~tn^^^^^^^ ''"f '"'■'^T'' '^""♦^ BerOhrungssensoren BS angebracht Mit dielen 

Kn.r R™^^nr ^^""i,^*' •P'!'''^rfi'1 ""^'^f Hindemisses in einer Steuereinheit in AbhSngig- 

keit einer Bewegungstrajektone des Effektors EF ein Ausweichmanflver eingeleitet werden. 

Eiif»Wtor?„"r'n^\y*^T''" Roboterarmes in Verbindung mit dem Effektor sind unterschiedliche 
« Sn Pff u? ^^'''''^'^ 5"'" "^"^ Beriihungssensors zum zweiten die Lage des BerOhrungs- 

^fnpTp I ^""L^l.""'" Fo"" des Effektors selbst Die einfachste Form des Effektors besteht in 

SnrfhS^!." n^^'^'o Berflhrungssensoren angebracht sind. Eine weitere AusfOhrungsform eines 
bffektors besteht darin daB das Rechteck beibehalten wird. jedoch eine Seite des Rechtecks mit der die Wand 
Deruhrt wird. als Halbkreis ausgebildet wird, an welchem raehrcre BerOhrungssensoren im gleichen Abstand 
angebracht werden. Bei der BerQhrung des Effektors mit einem Hindernis kann aus der Zahl und der Lage der 
Berimrungssensoren, welche ein Signal abgeben. in einer Steuereinheit darauf geschlossen werden. wie ein 
gceignetes AusweichmanSver, bzw. ein SteuermanSver um der Wand zu folgen, durchzufUhren ist Bei der 
AusfUhrungsform in Fig. 3 ist zu beachten. daB das Rad an welchen die Kraft gemessen wird. leicht Ober die 
K.ontur des Effektors hinausragt 

Diese AusfUhrungsform besitzt einige Vorteile. Zum einen kann die Kraft mit welcher der Effektor an die 
wand druckt kontrolliert werden. Zum anderen kann der Effektor viel besser gesteuert werden. da der Kraft- 
vektor auch eine Richtungsinformation bezflglich der Krafteinwirkung enthait Als weiterer Vorteil wirxJ die 
Keibung zwischen der Wand und dem Effektor vermindert Ein weiterer Vorteil besteht darin. daB mit dieser 
AusfUhrungsform nicht lediglich punktweise einzelne Signale geliefert werden. sondern daB einer Steuerungs- 
emheit des Armes eine kontinuierliche Kraftinformation zur VerfUgung gestellt wird und damit eine geschmeidi- 
gere Bewegung des Effektors erreichbar ist als wenn einzelne Schalter betStigt oder nicht betatigt werden. 

Bei der Steuerung des Armes und der Einheit kann durch die Aufnahme des Kraftvektors sichergesteilt 
werden, daB der Effektor absolut senkrecht zur Wand steht Zur Kontrolle des Effektors EF kann ein Kontroil- 
vektor angegeben werden. Dieser Vektor ist in Gleichung 3 des Formelteiles dargestellt Die ersten drei 
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Elemente reprasentieren dabei die zugewiesenen Geschwindigkeiten des Effektors. Die letzten drei Elemente 
reprasentieren die zugewiesenen Krafte und Momente die am Effektor ausgeUbt werden sollen. FUr den Fail, 
daB nur der Kraftsensor in Kontakt mit der Wand kommt, reduziert sich der KontroIIvektor auf die Form, 
welche in Gleichung 4 angege^en ist Dabei gilt zusatzlich Gleichung 5 und Gleichung 6. Der Vektor, der die 
Kraftrichtung angibt ist mit Tund der senkrecht darauf stehende Vektor ist mit n bezeichnet. Hier wird 
beispielsweise. nachdem ein Wandkontakt hergcsteiit wurde. der Effektor mit einer Kraft von Kj « 5N an die 
Wand gepreBt. Gleichzeitig soli er sich mit einer Winkelgeschwindigkeit von Of (tx) urn den Mittelpunkt des 
Sensors drehen bis der Kraftvektor, der gemessen wird, senkrecht auf die Y-Achse des Effektors steht (tx = 0.0). 
Dies wird dadurch erreicht, daB die Winkelgeschwindigkeit proportional zu tx gemacht wird Das bedeutet, daB. 
wenn diese Komponente gleich 0 ist, daB auch die Winkelgeschwindigkeit gleich 0 ist Urn Of schnell genug 
steuern zu kGnnen, muB eine bestimmte Funktion verwendet werden, urn es zu berechnen. Diese Funktion ist in 
Gleichung 6 des Formelteiles dargestellt. Falls beispielsweise die Kraftkomponente in X-Richtung sich einen 
gewissen Bereich um 0 herum nahert, wird der Effektor durch die Steuereinheit in X-Richtung bewegt wie dies 
Gleichung 5 angibt. Dabei kann beispielsweise so vorgegangen werden, daB er sich standig senl^echt zum 
gemessenen Kraftvektor bewegt In vorteilhafter Weise wird durch dieses reflexartige Verhalten dem Effektor 
ein Navigieren auch um konvexe oder konkave Ecken herum ermdglicht 

Um die Differentialgleichungen des Manipulatorarmes herzuleiten, wurde die Lagrange'sche Dynamik ver- 
wendet Die Gleichung dafilr ist in Gleichung 7 des Formeiteils angegeben. Das L in der Gleichung reprasentiert 
die Lagrange'sche, welche in Gleichung 8 angegeben ist Dabei ist mit T die Summe aus der kinetischen Energie 
der einzelnen Teile und mit V die Summe der Potentiellen Energie der Teile bezeichnet Mit qj werden die 
verallgemeinerten Variablen und mit Qj werden die veraligemeinerten extemen Krafte bezeichnet Die einzel- 
nen verschiedenen Segmente des Armes haben dabei eine Masse, eine Tragheit und eine Lange. Diese werden 
hier beispielsweise mit mi. ra2. mj, und Ii, I2, 13 und li, Ij. beschrieben. Die Lagerreibungskoeffizienten der 
einzelnen Drehlager werden dabei mit Bi bis B3 bezeichnet Jenes Armsegraent, das am Roboter festgemacht ist, 
erhaltdie Nummer l.In beiden Analysen wurden die lokalen Variablen 0 1 bis 03 in die globalen Variabienpi bis 
p3 umgesetzt Diese bedeuten dabei die jeweiiigen Wmkel, welche die einzelnen Armsegmente mit der globalen 
X-Achse bilden. Mit den Variablen Xi bis X3 und Yi bis Y3 werden die Koordinaten der Schwerpunkte der 
einzelnen Armsegmente bezeichnet Im einzelnen gelten in diesem Ausfuhrungsbeispiel folgende physikalischen 
Parameter: 

mi= 1kg m2= 1kg • m3= 1kg 



ll=0.4m l2=0,4m 13=0. 3m 



^" 12 ^^""TT" ^'"n 



m m m 

Fig. 4 zeigt ein Beispiel einer Ausfiihrungsform der erfindungsgemaBen autonomen mobilen Einheit In Teil a 
ist diese Einheit mit dem ausgesireckten Manipulatorarm dargestellt Die Einheit ist rait AE bezeichnet Sie 
besitzt Rader R, mit denen sie sich fortbewegen kann, indem diese beispielsweise angetrieben werden. Der 
Manipulatorarm ist hier in drei Segmenten dargestellt es kdnnen jedoch auch mehr oder weniger Segmente ftir 
seinen Aufbau verwendet werden. Die Berechnung der Kinematik gestaltet sich dann entsprechend aufwendiger 
Oder weniger aufwendig. Das Armsegment SGI ist in einem Drehlager DGl. welches eine Drehachse DAI 
besitzt an der autonomen mobilen Einheit AE befestigt An seinem Ende ist ein Segment SG2 in einem 
Drehlager DG2 mit einer Drehachse DA2 festgemacht AIs Segment 3 ist hier ein Effektor EF verwendet 
worden. Dieser Effektor ist mit einer Seite drehbar in einem Drehgelenk DG3 mit einer Drehachse DA3 an dem 
Armsegment SG2 befestigt 

Zu beachten ist hierbei, daB die einzelnen Achsen der jeweiiigen Drehgelenke achsparallel sind und senkrecht 
auf den Untergrund stehen. auf dem sich die Einheit fortbewegt In einzelnen AnwendungsfaJlen kann es auch 
sinnvoll sein, die Drehlage des Drehgelenks 1 anders als senkrecht zum Untergrund zu wahlen. Beispielsweise 
wenn Wande bemalt werden sollen, kann es sinnvoll sein den Arm nach oben auszustrekken, d. h. den Arm 
seitlich um 90* gedreht an einer Seitenwand der Einheit anzubringen. um damit Wande von oben bis unten 
tiberstreichen zu kOnnen. 

Fig, 4b zeigt cine erfindungsgemaBe autonome mobile Einheit mit einem eingezogenen Manipulatorarm 
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^«fvoM^nh«ftl d«e Segmentc SG2. SGI und der Effckior flbercinander zu liegcn kommen. Durch 

diesc vortei hafte Ausfflh^ des Manipulators wird vermieden, daB dieser im eingezoHcneSm^ 

sentlich tiber die Grundnache der autonomen mobilen Einheit AE hinausragt lampuiaior unwe 
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Formteil 



Tl = il(#,ar.- (/?!-*«)) 

Ta = i3(^f«r,- (ft-ft)) 



<!>/ 

J 



L ^applied 



C = 



0.0 



ijtrr - i/(A(^) 
0.0 



[ 0.0 if<, >A^ 

.if-*4<M.<A4 
*H irtjt, >ii:4 



ti = 0.5 
ib} = 10.0 
ib3=5.0 
A^ = Q.lradians 

r = Distance fromcentero J end - effectortocenterof wheel 



L = T-V 

Qj = ^Fx, Fy, T„thiele, fi - bi^i.rj - 6j^2. fj, - ta^sj 

^' = \-T-' — ■ 2 + + w)) • 

^ [/j^l + (ii + 3)1)] . 1 [/3/?i + m3 (x| + yl)] I 
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/si 



K = 0 

Ar/5+Ar = o 



0 



■(I) 



/i -f /? + ma + ma) /j/j {sll ^ ^^z) cos (A - 02) ^'3m,ce»fg,-g,) 

3 *3 » ^ 



/ -'irin^i(T^ + m, + m3)*+i,cos/?,(J^ + mj + m3)y + i,^i+ 

\ _IiiZij|!ng.j;^t^nj^j- ^ l.f,m,.inffl,-/>./ ^,^ 

^i'2 (t» + ma) sinOJj - ft) ^5 + _ r, 

lih (t» + ma) sin - +63^, + i?if""<«(e>-l>z) _ 



(12) 
(13) 
(14) 
(15) 



V = 0 
9i = {/?!. A, A) 

<?i = (n - 61^1, - 63^, Ts - 63^3} 

2} = {i + m, (ij + ^)] . I [j^^l + (i| + ^j)] , 1 [,^^, ^ ^ j J ^^^^ 

• (17) 



(18) 
(18) 
(20) 

(21) 
(22) 



(23) 



i?-t.-A,cos^(A-/7,M,cos»(A-^3)-i-.cos='(/%-A)+it.co»(ft-ft)cos(^^ 

(24) 

= ^'^^^3-HM^.,/3,»(I^,,„3),A£iZ^^^ 
A/,»/3'm3(^^.,4.n.3) ^^^^^^,^^,^ ,.,y,„^ ^ 

f "»» 4. . "»> ma Smj ma , ,\ 
V 16 +~ + -T~ + -"4— + "'3 j 

= (/3+^)(i:^ + m,m3+m3») 
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*3 

A, = 4-^ 

Cs = r 

4 

A = ^[(-cicos(/?i-/3!j) + C2COs(A-i32)cos(ft-A)) 



ft • = ^ [(-C7 COS (/72 - fii) + C8 COS - ^3)C0S (A -ft)) 



- 63 (ft -ft) - (lifil sin - ^j) + /j/jf sin (ft - ft) - x, sin ft + t?i cos /Js) j + 
(C9 - Cio cos^ (ft - ft)) 

(/i/?? sin (P2-Pi)-xi sin + W cos ^2) ) + 

(-•C3 cos - /?2) + C4 COS {0i - ^3) COS ()?2 - A)) 

. (;^, . . + ,3) sin - ^3) - ^^^3n.3^^|;-(^^-^3), 

^1 + ma + "13) (xisin A - yi cos/?l))] (26) 

= ;^ [(cu-ci2cos-(A -/?2)) 

^ra - 63 (^3 - ^2) - {hfil sin (A - P2) + /a^l sin (^3 - A) - xi sin ft + yi cos/?3) ^ + 

(-C7 cos {/?2 - ft) + Cs cos (A - ft ) cos (ft - ft)) 

(ra - 62 (ft - ft) - ^^^-"-^^ 7 '^^ -h{^^ ma) 

sin (ft - ) - XI sin ft + yi cos /?2) ) + 
(-ci cos (ft - ft) + C2 cos (ft - ft) cos (ft - ft)) 

f v (h k\ / / /""^a ^ \ 13 . ^ , /i/3m3/?gsin(ft - ft) 
I n - 61 ^ft - - hh + "^3; ^2 sin (ft - ft) ^ 

/i + m2 + ma) (xisinft - yi cos /?!))] (27) 



10 



(rz " 63 (ft " ft ) - ^ (/i4? sin (ft - ft ) + sin (ft - ft) - xi sin ft + yx cos ^3) ) + 

(-C3 COS (ft - ft ) + C4 COS (ft - ft ) cos (ft - ft )) 15 

[r, . 6, (ft . ft) _ /W5sin(ft-ft) ^^^ ^^^^^j 
(/i/?? sin (ft - ft) " £1 sinft + yi cos^2)) + 

(c5"C6C0s2(ft-ft)) 

[r, - 6. (ft . <t.) - (^ -h ma) &\ sin (ft - ft) . Mamaft^sinfft - ft) ^ 
/i (^ + + "^3) (^1 sinft - yi cos^l))] (25) 
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Cio 
Cl2 



/i/ama (/a + /a' (^4 mg)) 
2 

2 

= M,(f-Hn.3)(/3 + ^) 



4 

/3 /3 "»3 (A + /i' (t^ + tna + ma)) 
2 

2 

/i /a' ma 



= /1/3 + 



4 



= hh 



'"^ + ma) + hh^ + ma + ma) + 



+ hh- ( 

,1,2/ mo mj' mi ma 5 mo ma 

''''' V"^"*'"r+-4-+— 4—+'"=' ) 

h'^h^ ^il^ + mj ma + ma' j 



yj 
*/ 

^1 



I W J <fi-a 



L*/ 



AZ3 
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(35) 



5 




(36) 



10 



A(fi) = 



X/ + 

Vl - 



fa tin 

fa cos V f 
3 



(37) 



15 



*+ xo sin + J^o cos + sin (<^f + ^1) + /2 sin + + ^2) 




20 




j^^j - ic - (-X0 sin *c - yo cos - sin + ^i) - h sin + + ^2)) 
- ye - (xo cos $c - yo sin fl&c + /i cos + ^i) + cos ($c -f ^1 + ^2)) 
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Patentansprtiche 



30 



1. Autonome mobile Einheit mit Manipulator, 

a) bei der eine Steuereinheii zur Sleuerung von Bewegungen der Einheit und des Manipulators 
vorgesehen ist, 

b) bei welcher der Manipulator um eine Drehachse drehbar gelagert an einer GehSusebegrenzung der 35 
Einheit angebracht ist, 

c) bei welcher der Manipulator, aus mindestens drei sich langlich erstreckenden Segmenien besteht, 
welche an ihren Enden drehbar liber Drehlager miteinander verbunden sind, wobei die Drehlager 
jeweils eine Drehachse aufweisen, 

d) bei der die Drehachsen nSherungsweise zueinander achsparallel sind und im Wesentlichen senkrecht 40 
auf den Untergrund stehen, auf welchera sich die Einheit bewegt, 

e) bei der Stellmittel vorgesehen sind» mit denen die einzelnen Segmente unabhangig voneinander in 
ihren Drehlagern verdrehbarsind, 

f) bei der die Segmente so angeordnet sind, daB sie ftir den Fall in dem sie durch Verdrehung an der 
Gehausebegrenzung zu liegen kommen, den Anlegezustand, flbereinander zu liegen kommen, 45 

g) und bei der die L&nge und Breite der Segmente so bemessen ist, daB diese im Anlegezustand nicht, 
oder nur unwesentlich Qber die Grundflache der Einheit hinausragen. 

2. Autonome mobile Einheit nach Anspruch 1, bei der als Stellmittel tiber Umlenkrollen gefiihrte Seilziige 
vorgesehen sind. 

3. Autonome mobile Einheit nach Anspruch I, bei der als Stellmittel Motoren an den jeweiligen Drehgelen- 50 
ken vorgesehen sind 

4. Autonome mobile Einheit nach einem der vorangehenden Anspriiche, bei der die Segmente innen hohl 
und druckdicht miteinander verbunden sind 

5. Autonome mobile Einheit nach einem der vorangehenden Anspriiche, bei der das letzte Segment als 
Effektor ausgebildet ist 55 

6. Autonome mobile Einheit nach Anspruch 5, bei der der Effektor als SaugdUse, oder Pinsel ausgebildet ist 

7. Autonome mobile Einheit nach einem der vorangehenden Anspriiche, bei der das SuBcrste Segment 
mindestens einen Sensor zum Feststellen eines Hindernisses aufweist 

8. Autonome mobile Einheit nach Anspruch 7, bei der als Sensor ein Berlihrungsschaiter vorgesehen ist 

9. Autonome mobile Einheit nach Anspruch 7. bei der als Sensor ein KraftmeBfdhler vorgesehen ist 60 

10. Autonome mobile Einheit nach Anspruch 9, bei der als KraftmeBfUhler ein Rad auf einer Achse 
vorgesehen ist aus deren Verbiegung Ober DehnmeBstreifen der Kraftvektor abgeleitet wird 

11. Steuerverfahren fUr eine autonome mobile Einheit mit einem um eine Drehachse drehbaren Manipula- 
tor aus mehreren, an ihren Enden Qber Drehlager mit einer Drehachse verbundenen Segmenten bei der aile 
Drehachsen des Manipulators nfiherungsweise achsparallel sind und im Wesentlichen senkrecht auf den es 
Untergrund stehen, auf welchem sich die Einheit bewegt und die als fiuBerstes Segment einen Effektor mil 
KraftmeBfUhler besitzt 

a) bei dem falls der Effektor auf seinem Weg zu einem Ziel keiner Raumbegrenzung folgen soil, in 
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lore^eh^niM«,« ""^ vorgegeben werden ,und daraus Antriebsmomente fttr an den Drehgelenken 
vorgeseheneMotorenzumVerdrehenderSegmenteabgeleitetwerden.sodaBfOrdreiSegmSgat^ 



25=*3(<I>^-(P3-P2)) 

mit: 

Index 1, 2, 3, Nummer des Segmentes von der Einheit aus gezahlt 
Index tar Zielpunktbezogen 
T Antriebsdrehmoment 
k Regelparameter 

P zeitliche Ableitung einer globalen Variable 

O Winkel zwischen den einzelnen Segmenten. fUr das erste mit der x-Achse 

b) bei dem falls der Eff ektor einer Raumbegrenzung folgen soU tiber den KraftmeBf tthler die Andruck- 
durchTn^ und dem Effektor gemessen wird. wobei die Andruckkraft da- 
durch konstant gehalten wird, daB aus der Geometric des Manipulators der aktueU gemessenen 
Andruckkraft und emer Soil- Andruckkraft ein Korrekturmoment er^ttelt wird, welches z^d^^unter 
mentS^^^^ ""^ '^^^'""^ aufsummiert wird urn die jeweiligen Antriebsmo- 

Jprc'll^l'^""' Abhangigkeit einer aktuellen Strecklange des Manipulators die Einheit in Bewegung 
versetzt, bzw. angenaiten wird. 

12. Verfahren nach Anspruch 11. bei dem als Streckfaktor das Verhfiltnis aus aktueller Streckianee des 
Manipulators und moglicher Strecklange des Manipulators gebildet wird. wobei bd KscSen ein« 
uTter.n^rT.''"'" " fAr den Streckfaktor die Einheit in Wchtung des EffektorrUwegt S und be 
Unterschreiten eines zweiten Grenzwertes fOrden Streckfaktor die Einheit angehalten wird 
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